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NOMENCLATURE 



/ NBD x\ 

d = | NBD y ) 
\ NBD Z / 


x, y, and z accelerometer biases. 


x-, y-, and z- gyro drifts. 


e I’ e M* e O 



Intermediate accumulator for down- gyro torquing 
commands. 

Euler angles relating platform orientation to vehicle 
orientation. For three- gimbal systems, these are 
the inner, middle, and outer gimbal angles. For 
four- gimbal systems, these are the inner, outer- 
middle, and outer gimbal angles when the inner- 
middle gimbal is in its normal position. The outer- 
gimbal axis is parallel with Xg. When e^ = e M 
each platform axis has the same orientation as the 
corresponding vehicle axis. 

Intermediate accumulators for East - accelerometer 
signal processing. 

x-, y-, and z- accelerometer scale factor errors 
measured in parts per part (10 ppm). 


e o= o. 


G 


G-sensitive matrix which transforms specific force into its 
effect on gyro drifts via g-sensitive terms, for example. 



1 i 

^ADIA X 

ADOA x 

ADSRA X \ 

Ly P 

ADSRA V 

1 

ADIA y 

ADOA y ] 

LA yp ' 

Iadoa z 

ADSRA Z 

ADIA Z / 


where the g-sensitive drifts of the ith gyro are ADIA^ 
along the input axis, ADOA^ along the output axis, 
and ADSRA^ along the spin reference axis. 
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M 


n 


n 


P 


n P n 2 J n 3 

X B' y B' Z B 
x p' y p' z p 


i 


a 


n 


a 


Av = 



) 


Gyrocompass and level loop constants. 
k x = 06 2 k 3 k 4 = . 005 kg 

kg = 0003 kg kg = -. 5 kg 

kg = . 0655 mr/cm/s; e. g. , if the accelerometers are 
quantized at 1 cm/s and the gyros are quantized at 1 pr, 
then kg = 65. 5 gyro pulses/accelerometer pulse. 


Transformation matrix from navigation frame (x - North, 
y - East, z - down) to the platform frame. 

Number of seconds to be spent in the leveling mode be- 
fore proceeding to the gyrocompass mode; 640 seconds 
for the first pass and 320 seconds after an azimuth 
change. 

Number of passes through leveling/ gyrocompassing 
loop since the last gyro torquing sequence; counts 
up to 10. 

Intermediate accumulators for North- accelerometer 
signal processing. 

Cycle time for the compensation program; during pre- 
launch alignment, t^ = . 5 sec. 

Vehicle axes; at launch x is vertical up. 

Jl5 

Platform axes. 

Launch azimuth; desired angle from North to Xp about 
vertical down, e. g. , a 90° launch azimuth points 
Xp eastward. 

Vehicle azimuth; angle from North to Zg about vertical 
down. 

New launch azimuth; specified for an azimuth change. 


Integrated specific force measurements expressed in 
platform coordinates. 
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Accumulators for the x, y, and z integrating accelero- 
meters. 


Integrated specific force measurements expressed in 
the navigation frame; North, East, and Down. 


Accumulators for gyro pulse- torquing angles. 


^ - Vehicle latitude. 

u> - Earth rate; approximately 15. 04 deg/ hr. 

- Earth rate vector in navigation frame integrated for 

— tj 

5 seconds; used for earth rate compensation. 
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1 . 


INTRODUCTION 


The prelaunch- alignment program aligns the stable platform to some 
desired orientation with respect to the local navigation reference frame. 
The alignment progresses in three distinct phases: coarse aligning, 
leveling, and gyrocompassing. While the program is in the leveling or 
gyrocompassing phase, a new launch azimuth may be specified without 
reinitiating the program. At liftoff, control is passed to a navigation 
monitor/ control program. A description of the stable-platform- compen- 
sation program is included. 

The programs and equations given in this document are similar to 
those used for Apollo. 
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2. FUNCTIONAL FLOW DIAGRAMS 

Since interaction between the prelaunch alignment program and the 
platform compensation program is desirable, a description of the latter pro- 
gram is included. 

In the compensation program, accelerometer measurements are 
corrected for known biases and scale-factor errors, and gyro torquing angles 
which will offset the known gyro drifts are computed. If no other program is 
torquing the gyros or needs the integrated specific- force measurements, 
then synchronized torquing is not specified and the compensation program 
torques the gyros. Otherwise, synchronized torquing should be specified to 
minimize pulse- torquing errors and control is passed to the synchronizing 
program which is responsible for torquing the gyros. In either case, the 
compensation cycle time must be specified. 

After initialization and coarse- aligning the gimbals, the prelaunch 
alignment initialization program initiates the compensation program with a 
. 5 second cycle time specifying the prelaunch alignment program as the 
synchronizing program. The leveling phase is also specified for the 
alignment program. 

When the compensation program passes control to the alignment 
program, the integrated specific- force measurements are filtered to produce 
gyro torquing angles. After every ten passes through the program, the 
torquing commands are actually sent to the gyros. When liftoff occurs, 
gyro torquing is desynchronized and control is passed to a navigation 
monitor/ control program. 

Initially, the leveling phase lasts for 640 seconds after which the 
gyrocompassing phase is entered. When an azimuth change is requested, 
the gyros are torqued to position the platform in the new desired orientation 
and the leveling phase is again entered. If the azimuth change is requested 
before first entering the gyrocompassing phase, then the next leveling phase 
lasts for 640 seconds; otherwise, subsequent leveling phases last for 320 
seconds. 
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ENTER 



/Has 

Liftoff 

Occurred 


Initialize the Prelaunch Align- 
ment Program for leveling 


Program Alarm: Liftoff has 
occurred before the platform 
alignment was adequate 


Initialize Compensation Program 
for synchronized torquing with 
the Prelaunch Alignment Program 


Navigation Monitor Control 
Program 
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ENTER 



EXIT 


Figure 2. Compensation Program 
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ENTER 




(Figure 1) 


Figure 3a. Prelaunch Alignment Program 














EXIT 


Figure 3b. Prelaunch Alignment Program 
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3. 


INPUT AND OUTPUT VARIABLES 


The gyro and accelerometer performance parameters are loaded 
and/or verified in the prelaunch alignment initialization program, but 
they are passed on to and only used by the compensation program. 


3. 1 Prelaunch Alignment Initialization Program 
Input variables: 


0 

a 

o! 

b 

£ 

d 

G 


latitude 

launch azimuth 
vehicle azimuth 
accelerometer biases 
accelerometer scale- factor errors 
non- g- sensitive gyro drifts 

matrix of g- sensitive gyro drifts 


Output variables: 


M 

' 

transformation matrix from the navigation frame 
to the platform frame. 

-E 

- 

earth rate vector in the navigation frame 
integrated for 5 seconds. 

e r 

e M* 


e o 


gimbal angles. 

*c 

- 

compensation cycle time. 

Also, 

the following parameters are initialized: 

n 

- 

number of seconds to be spent in the leveling phase. 

n l* 

n 2’ 


n 3 . 

e l. " 

intermediate accumulators for the prelaunch alignment 

e 2’ 

d 9 

e 3’ 

program. 
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T 

Av' 


number of passes through the prelaunch alignment program 
since the last gyro-torquing sequence. 

gyro-torquing angles, 
accelerometer accumulators. 


3.2 Compensation Program 
Input variables: 


Av' 

t C 

b 

f_ 

d 

G 


accelerometer measurements, 
compensation cycle time. 

accelerometer biases 
accelerometer scale-factor errors, 
non- g- sensitive gyro drifts 
matrix of g- sensitive gyro drifts. 


Before initiating the compensation program, the following should be 
initialized: 

Av' - Accelerometer accumulators 

r - Gyro torquing angles 

Output variables: 

Av_ - Integrated specific force measurements expressed in 

platform coordinates. 

r - Gyro torquing commands adjusted to compensate for 

known gyro drifts. 

Av' is reset to zero 

3. 3 Prelaunch Alignment Program 
Input variables: 

M - Transformation matrix from the navigation frame to the 
platform frame. 

Av - Integrated specific force measurements expressed in 

platform coordinates. 

co E - Earth rate compensation vector. 
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a 


New launch azimuth. 


- Unexecuted gyro-torquing commands. 

It is assumed that the following have been initialized: 

n - Number of seconds to be spent in the leveling 

phase. 


n l* n 2, 
n 3* e l, " 

^OJ 


Intermediate accumulators. 


n 

P 


Number of passes through the program since the 
last gyro-torquing sequence. 


Output Variables: 

t - Updated gyro-torquing angles . 

n - Number of seconds to be spent in subsequent 

leveling phases. 
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4. DESCRIPTION OF EQUATIONS 

4. 1 Prelaunch Alignment Initialization Program 

This program executes the coarse aligning phase and initializes para- 
meters used by the compensation program and the prelaunch alignment 
program. Since Xg is vertical, the gimbal angles used in coarse aligning 
take the simple form 

e I = *! 2 

= 0 

= a -a' 


'M 


c O 

If x^, or z— is not vertical, more complicated expressions for the gimbal 
ID Jr 

angles might be required. 

4. 2 Compensation Program 

The accelerometer measurements corrected for known biases and 
scale- factor errors are given by 

Av. = (1 + ASF i > Av| - b i t c , i = X, Y, Z 
The amount of platform drift accumulated over the previous t 


seconds is 


rNBD. 

J. 

NBD^ 

iNBD, 


+ ! G 


'Av 
A v -, 

AV, 


X 


This drift is removed from the gyro-torquing angles before the torquing 
commands are issued. 

4. 3 Prelaunch Alignment Program 

The integrated specific force measurements are transformed to the 


navigation frame by M \ (Since M is unitary, M ^ 
East components are filtered as follows: 

n l,i+l = n l,i + - 1 (AV N,i- Vi* 
n 2, i + 1 = ^L, i+1 + n 2, i 


M ) The North and 
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where i represents the ith iteration and n is replaced by e to obtain the East 
filter, and e2 resemble derivatives of Av^. and Av or specific forces. 

In the leveling phase, the final filters are: 

n 3, i + 1 = n 3, i + k 4 (n l, i + 1 + k 5 n 2, i + 1 J 
e 3, i + 1 = e 3, i + k 4 (e l, i + 1 + k 5 e 2, i + 1* 

which resemble 

(specific force) + k^k,. 

dg is set to zero. 

In the gyrocompassing phase, the final filters are: 

n 3, i + 1 = ^ n 2, i + 1 
e 3, i+1 = e 3, i + k l e l, i + 1 + k 2 e 2, i + 1 

d 3, i + 1 = k 3 n 2, i+1 




(specific force). 


which resemble 


n 

e 

d 


3 

3 

3 


(specific force) 
(specific force) + kg 
(specific force) 


J (specific force) 


In either phase, n 3 , e 3 , and d 3 are the commands to be sent to the 
"East", "North", and Down gyros, respectively. 


After ten iterations, the earth- rate compensations are added to these 
commands and the results are transformed to the platform frame by M: 


gyro-torquing angles = M 




These are added to the gyro-torquing- angle accumulators which are then 
used as the commands to physically torque the gyros. 


4-2 



5. DETAILED FLOW DIAGRAMS 


UNIVERSAL 

CONSTANT 


INPUT VARIABLES 



Figure 4a. Prelaunch Alignment Initialization Program 
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EXIT 


Figure 4b. Prelaunch Alignment Initialization Program 
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INPUT VARIABLES 



Figure 5. Compensation Program 
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INPUT VARIABLES PROGRAM CONSTANTS 



( Figure 4b) 


Figure 6 a. Prelaunch Alignment Program 
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Figure 6b. Prelaunch Alignment Program 
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EXIT 


Figure 6 c. Prelaunch Alignment Program 


5-6 









6. SUPPLEMENTARY INFORMATION 

The implementation of the programs described in this document is 
dependent on the characteristics of the equipment used. Consequently, minor 
modifications to the programs may be necessary. 

If the compensation program cannot be cycled precisely at the desired 
rate, then the compensation cycle time, should be measured for each pass. 
It may be necessary to compute the amount of earth- rate compensation after 
every ten passes if the real cycle time can vary significantly. 

It has been assumed that the gyro-torquing accumulators are de- 
cremented by the amount that the gyros have been commanded. If this is 
not the case, then the programmer must be responsible for decrementing 
the accumulators. For torquing accuracy considerations, fractions of 
pulses should be saved. It may also be desirable to torque a gyro only if 
it is to receive more than a certain number of pulses; that number depends 
on the torquing characteristics of the gyros. 

The prelaunch alignment mechanization described here has a twenty 
minute time constant. If disturbances such as vehicle sway are minimal, 
then the steady state should be reached after approximately 1 1/4 hours. 
Approximately ten minutes are required after an azimuth change of 
several degrees for the platform to stabilize to the same accuracy as 
immediately prior to the azimuth change. This time varies with the 
magnitude of the change. 
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